/*
 * algoritmo.h
 *
 *  Created on: 25/03/2014
 *      Author: Michelangelo
 */

#ifndef ALGORITMO_H_
#define ALGORITMO_H_

void Alg_FirstPoint();
void Alg_FirstGoal();
void Alg_SecondGoal();
INT16U Alg_GetHeadingValue();
INT16U Alg_GetDistanceValue();
BOOLEAN Alg_Alignment(INT16U anguloGravado, INT16U anguloAtual);
void Alg_FindCone ();


typedef enum
{ /*do not change order*/
  TESTIN90 = 0,
  GOTO0,
  GOTO180,
  COMPARE,
  END
}Find_State_t ;

#endif /* ALGORITMO_H_ */
